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摘 要 : 和 迭代 最 近 点 (ICP) 算 法 由 于 其 配 准 精度 很 高 ， 通 常 运用 于 点 云 的 精 配 准 ， 但 其 配 准 精度 和 选 代 收 么 性 取决 于 待 
配 准 点 云 的 初始 位 置 。 提 出 一 种 将 遗传 算法 和 空间 分 布 箭 相 融 合 的 空间 最 优 变换 矩阵 求解 算法 ， 以 一 种 新 的 点 云 空 间 
位 置 评价 方法 一 一 空间 分 布 炳 作为 遗传 算法 的 目标 函数 ， 采 用 遗传 算 子 指导 解 的 搜索 方向 ， 通 过 新 种 群 的 不 断 迁 代 达 
到 空间 分 布 炉 最 小 ， 结 束 后 对 最 优 个 体 解 码 实 现 点 云 的 粗 配 准 。 实 验 表 明 ， 该 算法 有 效 可 行 ， 克 服 了 传统 方法 在 有 点 
云 缺 陷 和 噪声 点 时 不 能 提供 很 好 的 初始 拼接 位 置 的 问题 ， 在 误差 允许 的 范围 内 ， 可 以 直接 实现 点 云 拼接 。 
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Point cloud registration based on entropy criterion genetic algorithm 


Chen Jie’, Cai Yong™ t, Zhang Jianshengs 
(a. School of Manufacturing Science & Engineering, b. Key Laboratory of Testing Technology for Manufacturing Process, 
Southwest University of Science & Technology, Mianyang Sichuan 621010, China) 


Abstract: The iterative closest point (ICP) algorithm is usually used in the fine registration of point cloud because of its high 
registration accuracy, but its registration accuracy and iteration convergence depend on the initial registration position of the 
point cloud to be registered. This paper proposed an algorithm of spatial optimization transformation matrix combining genetic 
algorithm with spatial distribution entropy, in which used a new point cloud spatial position evaluation method as the objective 
function of genetic algorithm, used and genetic operator to guide the solution of search direction. The algorithm achieves the 
minimum spatial distribution entropy through the new population of iterations, after which the coarse registration of point cloud 
is achieved by decoding the optimal individuals. The experimental results show that the algorithm is effective and feasible, and 
it can overcome the problem that traditional method can’t provide a good initial position when the defects and noise exist in the 
point cloud. The algorithm can directly realize point cloud registration within the acceptable error range. 
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0 引言 联系 的 ， 要 完整 、 真 实 的 来 表示 物体 的 轮廓 ， 需 要 将 多 个 角度 
扫描 的 点 云 经 过 坐标 变换 放 在 同一 个 坐标 系 下 ， 这 个 操作 就 是 

随 着 三 维 扫描 仪 不 断 的 向 高 精度 、 高 质量 发 展 并 且 越 来 越 ”点 云 配 准 。 
普及 ， 三 维 扫描 的 点 云 配 准 技术 是 非常 重要 的 技术 ， 已 经 在 许 点 云 配 准 本 质 上 是 计算 旋转 平移 矩阵 ， 目 的 是 使 物体 表面 
多 行业 有 大 量 的 应 用 。 如 道 向 工程 、 产 品 检测 、 机 器 人 姿态 调 同一 个 部 位 的 点 云 重 合 在 一 起 。 一 般 在 粗 配 准 后 再 进行 精 配 准 
整 、 文 物 保 护 、 计 算 机 视觉 、 计 算 机 图 形 学 和 模式 识别 等 领域 。” 是 点 云 配 准 中 比较 常见 并 且 有 效 的 方法 。 粗 配 准 就 是 把 初始 位 


有 广泛 的 应 用 ， 是 一 个 非常 重要 的 研究 领域 。 操 纵 各 类 扫描 仪 置 任意 的 两 片 点 云 放 在 大 体 正确 的 位 置 上 ， 以 便 为 精 配 准 提 
器 对 物体 的 轮廓 来 准确 采样 ， 得 到 三 维 空间 一 些 分 散 的 的 点 ， 良好 的 初始 位 置 ， 使 配 准 收敛 到 全 局 最 小 ， 提 高 配 准 的 效率 和 


和 


所 有 点 的 集合 称 为 点 云 。 利 用 获取 的 模型 轮廓 的 采样 点 来 表示 “精度 ， 精 配 准 是 使 物体 表面 同一 个 部 位 的 点 云 到 达 完 全 重合 的 


模型 ， 


在 计算 机 上 通过 点 云 信息 进行 三 维 重建 。 对 于 体积 庞大 ”状况 。 


和 表面 复杂 的 物体 ， 每 次 只 能 扫描 物体 一 部 分 ， 如 果 要 形成 一 Besl 等 人 口 在 1992 年 首次 提出 了 和 迭代 最 近 点 (iterative 


个 完整 的 模型 往往 需要 多 次 扫描 完成 。 获 取 的 点 云 是 相互 没有 closetestpoint，ICP ) 算法 ， 该 算法 在 配 准 正确 的 情况 下 


有 很 高 
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陈 ” 杰 ， 等 : 


的 精度 ， 是 现在 最 成 熟 最 优良 的 精 配 准 算法 。 原 始 ICP 算法 的 


基本 思想 是 : 在 两 点 集中 寻找 对 应 点 ， 并 计算 所 有 相对 应 
点 欧 氏 距 离 平 方 的 平均 值 ， 并 同时 更 新 点 云 之 间 的 相对 位 置 ， 
再 重复 以 上 的 过 程 直至 算法 收敛 ， 算 法 收敛 即 平 均值 最 小 ， 两 
片 点 云 达到 最 佳 的 位 置 ， 至 此 点 云 配 准 完成 。 

Besl 提出 的 经 典 ICP 算法 的 缺点 和 局 限 有 很 多 : 第 一 ， 原 
台 ICP 收敛 速度 和 是 否 收敛 于 正确 的 位 置 在 很 大 程度 上 依赖 于 
初始 位 置 ;， 第 二 ， 每 一 次 迭代 都 需要 为 每 个 点 寻找 最 近 点 ， 产 
生 对 应 点 ， 那 么 当 点 云 数 量 比较 大 将 会 非常 耗 时 ， 第 三 ， 由 于 
两 片 点 云 是 部 分 重合 且 存 在 噪声 点 ， 有 些 点 云 并 没有 相对 应 的 
点 ， 而 原始 ICP 假设 的 是 这 些 点 是 不 存在 的 ， 而 当 存 在 这 些 点 
时 又 没有 被 剔除 ， 将 会 严重 影响 算法 的 运行 效果 。 针 对 以 上 缺 
点 和 局 限 性 ， 国 内 外 许多 学 者 对 该 算法 进行 了 改进 ， 并 以 此 形 
成 了 许多 变种 的 ICP 算法 PR。 

为 了 解决 文章 提 到 的 ICP 依赖 初始 位 置 的 缺陷 学 者 提出 一 
系列 粗 配 准 方法 , 文献 [2] 使 用 PCA(Cprincipal component analysis ) 
主 成 分 分 析 法 ， 能 快速 的 进行 点 云 配 准 ， 但 是 针对 有 大 量 噪声 


Er 


程度 ， 使 算法 具有 优良 的 鲁 棒 性 。 


1 ”算法 简介 


八 叉 树 对 待 配 准 的 点 云 P 和 点 云 Q 建 立 三 
佳 立 方 栅 格 ， 然 后 统计 在 每 一 个 立方 栅 格 内 的 点 云 的 点 数 ， 最 
后 求 取 点 云 空间 分 布 焙 。 点 云 配 准 分 两 步 : 粗 配 准 和 精 配 准 。 
粗 配 准 运用 空间 分 布 焙 准 则 为 目标 函数 ， 遗 传 算法 求解 空间 最 
优 变换 矩阵 ， 精 配 准 使 用 改进 ICP 算法 求解 满足 精度 的 空间 变 
换 。 
1.1 空间 立体 栅 格 

本 算法 利用 八 又 树 09 建 立 空间 立方 栅 格 ， 采 用 分 割 结束 的 
条 件 为 节点 机 格 对 角 线 长 度 的 平方 ， 即 : 


该 算法 首先 运 


hs 


1 = (xm Xin ) 十 (yer 一 Jin ) 十 (Eos Lmin ) (1) 


其 中 Ww yma Zmar 为 节点 栅 格 每 个 坐标 轴 方 向 上 的 最 大 值 ， 
Nnin 于 Yimin . Zinin 为 最 小 值 。 
每 个 栅 格 大 小 是 相同 的 ， 由 于 点 云 数据 通常 不 是 均匀 的 ， 
全 
口 


和 只 有 部 分 重合 的 点 云 不 能 很 好 地 提供 优良 的 初始 位 置 ， 文 献 
[3] 通 过 提取 点 云 边界 特征 点 ， 在 匹配 边界 点 以 实现 粗 配 准 ，1 
是 该 方法 精度 不 高 ,并 且 特 征 提取 比较 耗 时 ; 文献 [和 通过 迭代 最 
小 空间 分 布 箭 法 为 点 云 实现 粗 配 准 ， 但 该 方法 精度 不 高 ， 且 比 
较 耗 费时 间 。 

近 些 年 来 也 提出 一 些 随 机 算法 G20， 文 献 [3 采取 优化 算法 
中 遗传 算法 结合 均值 平方 误差 (MSE) 度 量 准 则 来 实现 点 云 粗 配 
准 ， 虽 然 精度 较 高 但 效率 很 低 ; 文献 [6] 提 出 一 种 将 优化 算法 中 
遗传 算法 结合 O'Rourke 算法 求解 最 小 包围 盒 的 算法 ;Chen 等 
人 [9 在 1999 年 首次 运用 RANSAC 算法 进行 三 维 点 云 配 准 ， 该 


方法 有 较 高 的 鲁 棒 性 ， 不 需要 模型 的 几何 特征 ， 也 不 需要 提供 
初始 位 置 ， 对 小 部 分 重合 的 点 云 处 理 非常 有 效 ， 但 是 时 间 复 杂 


度 非 常 大 ; 文献 [9] 提 出 了 4PCS (4 point congruent set) 技术 结 
合 RANSAC 算法 ， 对 以 前 随机 抽样 三 个 点 改 用 四 点 集 充 分 利 
用 图 形 的 几何 关系 ， 加 快 对 应 点 集 搜索 速度 ， 虽 然 4PCS 技术 


极 大 的 提高 了 RANSAC 方法 的 效率 ， 但 是 O(N? ) 算法 复杂 度 


I 


针对 庞大 的 数据 耗费 的 时 间 也 是 比较 多 的 ; 文献 [10] 运 用 采样 
球 配 准 方法 ， 加 快 了 寻找 与 “ 基 ” 重 合 的 三 点 基 ， 同 时 在 噪声 


进行 栅 格 化 后 每 个 栅 格 中 的 点 数 是 不 同 的 。 点 云 重 
对 于 其 他 部 分 的 点 云 要 密集 一 点 ， 点 云 的 政 密 程度 通过 栅 格 中 
点 数 的 多 少 能 很 好 的 描述 ， 即 点 云 分 布 越 密集 该 区 域 的 栅 格 点 
数 越 多 ， 反 之 越 稀 玻 。 
1.2 空间 分 布 灶 

本 文 的 空间 分 布 粹 由 是 描述 的 点 云 的 位 置信 息 与 信息 粹 中 
有 许多 相似 之 处 .不 同 视角 扫描 的 点 云 空间 位 置 通常 是 任意 的 ， 
处 于 不 同 的 坐标 下 位 置 相 差 很 大 ， 因 此 不 确定 性 也 非常 大 。 当 
两 点 云 实现 了 配 准 ， 相 对 位 置 是 最 小 的 ， 也 是 唯 
云 的 空间 分 布 炉 能 准确 的 描述 点 云 配 准时 的 位 置 
间 分 布 炉 求解 流程 如 下 : 
(1) 点 云 DD 包 含 N 个 数据 点 ， 将 其 利用 
三 维 栅 格 化 。 
(2) 点 云 被 顶 格 划分 ， 记 录 每 个 立方 栅 格 分 配 的 点 记 为 


n(i,j,k) ,并 计算 点 云 落 在 每 个 立方 机 格 内 的 概率 p(i,j,k) , 计 
算式 为 
ee n(i, j,k) 
,有 = 一 一 一 一 (2 
p(i,j,k) ) 
其 中 : 1=123 jn,; j=12,3 ,n,; 大 =123 ;nn,, n,n 分 


点 和 异常 值 点 的 抵抗 能 力 比 以 前 的 RANSAC 配 准 更 强 ， 文献 
[12] 针 对 局 部 大 变形 模型 进行 处 理 ， 利 用 遗传 算法 提供 初始 位 
置 在 利用 ICP 算法 进一步 配 准 得 出 某 一 偏差 值 ， 设 定 该 偏差 什 
为 闪 值 去 除 偏 差 大 的 点 云 ， 剔 除了 局 部 大 变形 的 点 云 在 运用 最 
小 二 乘法 进行 配 准 ， 文 献 [13] 改 进 遗 传 算法 目标 函数 为 测量 点 
到 三 角 面 片 的 距离 平方 和 , 并 利用 参考 球 加 快 了 距离 计算 速度 ， 
大 大 节省 时 间 。 基 于 以 上 分 析 ， 提 出 一 种 基于 炉 准 则 遗传 算法 
的 点 云 粗 配 准 方法 ,使 用 空间 分 布 和 做 为 遗传 算法 的 目标 函数 ， 
能 快速 将 未 知 任何 信息 的 两 片 点 云 放 在 大 体 的 位 置 上 ， 为 精 配 
准 提供 良好 的 初始 值 。 空 间 分 布 烂 能 准确 的 度量 空间 点 云 贴 合 


别 表示 每 个 坐标 轴 方 向 的 栅 格 数目 。 
(3) 计算 点 云 D 的 空间 分 布 粹 (SDE)， 计 算式 为 


Es =-Y D5 pi j,k) In p(i j,k)] @) 


i=1 j=1 k=1 


由 算法 可 知 ， 点 云 空 间 分 布 焙 CSDE) 只 需要 建立 三 维 
格 统计 落 在 每 个 栅 格 中 点 数 ， 算 法 的 时 间 复 杂 度 是 很 低 的 ， 而 
均值 平方 误差 (MSE) 外 需要 为 一 片 点 云 的 每 一 个 点 ， 到 男 外 一 
片 寻找 最 近 点 形成 一 一 对 应 点 ， 每 次 都 需要 全 局 遍历 ， 因 此 算 
法 的 时 间 复 杂 度 很 高 。 


已 知 给 出 完全 重合 的 


Lx 


| 


| 


片 bunny 模型 点 云 P 和 OQ， 现 对 0 


201805.00190v1 


chinaXiv 


录用 稿 


进行 如 下 操作 : 将 其 


D(O) 


示 的 为 MSE 的 值 ， 图 


MSE 与 旋转 角度 关系 


值 。 表 1 给 


和 


MSE 


| 


pk 
6.4 EE 


SDE 与 旋转 角度 关系 


aid 


No Dv * 虽 om © 


(MSE 


-1 0 
旋转 角度 /(rad) 


1 


-1 0 
旋转 角度 /(rad) 


| 


(b)SDE 


图 1 不 同 空间 位 置 的 评估 什 


表 1 MSE 和 S 


DE 计 


估 点 云 空间 位 置 的 时 间 比 较 


点 云 评 估 


MSE SDE 


Times/s 


93.159261 


3.135315 


云 完全 配 


估计 点 云 空间 位 置 运 行 效率 比 MSE 高 很 多 ， 可 以 ) 


Ea! 


调用 。 


P(i,j,k) ， 在 相反 


空间 3 


泄 赎 


间 位 置 表示 的 越 精确 ， 


但 是 随 着 立方 机 格 的 增长 计 


相应 的 增加 ,所 以 合理 选择 


分 割 结束 条 件 对 算法 性 


考虑 到 空间 分 布 粹 对 空间 位 置 估 计 的 


效 性 


bunny 模型 选用 节点 


和 


绕 Z 轴 顺 时 针 旋转 角度 9, 9 在 -和 ~ 元 之 
间 以 0.031 4 rad 等 间隔 取 值 ， 旋 转 后 的 8 记 为 8(9) 。 
P 卫 和 Q(9) 组 成 , 计算 D(9) 的 MSE 和 SDE, 图 
1(b) 所 示 的 为 SDE 的 
用 MSE 和 SDE 评估 整个 2(6) 点 云 空间 位 置 所 需 时 间 的 比较 。 


点 云 
1(a) 所 


出 了 采 


图 1 可 知 ，MSE 和 SDE 都 满足 空间 位 置 的 估计 ， 当 点 
住 时 MSE 和 SDE 都 是 全 局 最 小 。 由 表 1 可 知 ，SDE 
于 频繁 的 

于 空间 分 布 粹 是 基于 点 云 落 在 每 个 立方 栅 格 内 的 概率 


内 建立 的 立方 栅 格 越 多 对 点 云 的 空 
| 算 的 时 间 也 
能 改善 很 大 。 


陈 ” 杰 ,等 : 基于 六 准则 遗传 算法 的 点 


e] 和 迭代 终止 。 满 足 和 迭代 终 止 条 件 ， 
进化 过 程 中 最 优 的 个 体 就 是 最 优 解 。 
2 ”基于 业 准 则 遗传 算法 配 准 

本 文 利 用 异 E 则 的 遗传 算法 进行 粗 配 准 。 首 先 确定 
标 函数 , 空间 分 布 炉 度量 两 片 重合 部 分 重合 程度 确定 位 置 关系 ; 
然后 根据 遗传 算法 的 操作 选择 、 复 制 、 交 叉 、 变 异 不 断 迭 代 ; 
最 后 找 出 最 优 的 旋转 和 平移 矩阵 。 


于 炉 闪 


2.1 目标 函数 的 建立 

配 准 的 目标 是 把 不 同 角度 扫描 的 点 云 转 换 在 同一 视角 下 ， 
点 云 空间 分 布 炉 能 快速 、 准 确 地 计算 转换 的 结果 ， 将 空间 分 布 
炉 作为 遗传 算法 的 目标 函数 ， 即 将 遗传 算法 的 目标 设 定 为 解决 
点 云 空 间 分 布 烂 的 最 小 值 求解 问题 。 设 空间 分 布 粹 函数 为 


Esp(P，Q,)， 其 中 了 为 参考 点 云 ，Q 为 变换 后 的 目标 点 云 。 基 
于 该 函数 可 精确 获得 局 部 最 优 解 ， 遗 传 算法 中 每 个 个 体 都 需要 
]， 将 其 作为 目标 函数 能 够 


计算 目标 函数 ， 因 此 需要 频繁 的 调 
保证 求解 精度 ， 有 效 缩小 搜索 范围 ， 有 助 于 提高 遗传 算法 的 运 
行 效率 。 

2.2 ”遗传 算法 的 选择 

2.2.1 染色 体 实 数 编码 


= 


三 维 空间 的 物体 具有 六 个 自由 度 即 三 个 转动 和 三 平移 
[Q;B,7,T.,T,,T |]， 变 换 矩 阵 可 由 六 个 自 变量 组 成 旋转 自 变 量 


Q,B,y 的 变化 范围 为 [-x，X] ,平移 自 
点 云 了 得 到 ,每 个 坐标 轴 方 向 的 变化 范 


变量 的 变化 范围 由 参考 
时 [x x], [=y, y], [=z,z] 


决 速 性 


， 本 文 


格 对 角 线 长 度 的 平方 1 为 0.003。 表 2 对 


选用 bunny 模型 对 空 


验证 。 


间 分 布 炳 


十 计 点 云 位 置 有 效 性 和 快速 性 


的 


表 2 节点 栅 格 的 长 度 对 运行 时 间 的 比较 


长 度 0.001 0.003 0.005 0.007 
Times/s 3.568808 2.876564 2.814571 2.794607 
1.3 ”遗传 算法 
遗传 算法 0% 站 7 是 一 种 进化 学 习 的 优化 算法 。 由 于 遗传 算法 
进化 学 习 不 断 保留 优良 个 体 同时 又 产生 新 的 个 体 特点 ， 所 以 不 
仅 具 有 极 强 的 鲁 棒 性 ， 也 可 以 利用 设计 变量 在 设计 空间 进行 多 


点 搜索 ， 具 有 较 强 的 全 
敛 性 及 对 初始 值 要 求 不 


a) 编 码 。 将 求解 的 问题 转换 为 遗传 算法 的 基 


b) 初 始 群 体 的 生成 。 随 机 生成 一 个 种 尹 
9 适应 度 值 评 价 检测 。 根 和 


价 个 体 的 适应 性 。 


局 搜索 能 力 ， 同 时 该 方法 还 具有 全 局 收 


严格 


的 特点 。 遗 传 算法 过 


的 基因 型 数 


程 描述 如 下 : 
姑 型 串 结构 数 


mi 


居 目 标 确定 合适 的 适应 度 函 数 评 


dd) 选择 与 遗传 。 种 群 中 优良 的 个 体 被 选择 遗传 到 下 一 代 ， 
子 代 由 父 代 交叉 变异 产生 更 优 的 个 体 。 


可 表示 为 


x=(x 


max 


—xXnn) /2 
y= (Yor — yn ) /2 (4) 
Z= (Zi —Z )/2 

其 中 ;Xar ， Xin ， Ymar ;ymin ; Zmar ， Zmin 分别 为 点 云 己 在 式 、 
Y、Z 坐标 轴 方 向 上 的 最 大 值 与 最 下 值 。 
2.2.2 适应 度 函 数 

在 遗传 算法 中 实现 “自然 选择 ”最 重要 的 依据 是 适应 度 函 
数 。 本文 的 目标 函数 是 空间 分 布 炉 (SDE), SDE 小 的 个 体 是 优良 
个 体 被 选择 概率 越 大 。 本 算法 采用 基于 排序 的 适应 度 分 配 。 根 
据 个 体 SDE 值 按照 由 小 到 大 顺序 排序 , 并 通过 适应 度 函 数 计 算 
出 对 应 个 体 的 适应 度 值 FinV。 有 适应 度 函 数 可 知 FitnV 越 大 个 
体 越 优良 。 

适应 度 函 数 为 


min 


[a 


Pos—!l 


= 5 
Nind —1 号 


FitmV(Pos)=2—sp+2x(sp—D)x 


其 中 :sp 为 个 体 的 SDE 值 ;Pos 该 种 群 排序 后 在 种 群 中 的 位 置 ; 

Nind 为 种 群 个 体 的 数量 。 

2.2.3 选择 与 遗传 
本 文采 用 杰出 策略 方法 进行 选择 操作 算 子 ， 即 当前 最 优 给 

提 直 接 传 给 下 一 代 ， 采 用 随机 遍历 抽样 选择 法 来 对 其 他 的 染色 
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宰 


进行 选择 ， 随 机 遍历 抽样 选择 法 是 依据 随机 产生 的 种 群 ， 产 
一 个 随机 数 就 产生 一 个 染色 体 ， 而 它 被 选中 的 概率 与 其 适应 
函数 成 正比 : 


| 证 
HT 


a 


Ye6) (6) 


其 中 : f (x) 是 


个 体 太 的 适应 度 ，F( 罗 ) 是 这 个 个 体 被 选择 的 概 


于 染色 体 采 用 实数 编码 的 范式 ， 交 叉 算 子 也 同样 采用 实 
数 交 叉 算 子 中 的 离散 重组 。 变 异 算 子 采用 实 值 种 群 的 变异 。 一 
个 变量 的 变异 是 由 以 下 计算 得 到 的 : 

X =X+MutMxxrangex Bx delta (7) 
其 中 : MutMx 控制 是 否 变异 ， 数 值 在 1、0、-1 中 随机 取 数 ; 
range=0.5 x 变量 的 域 ( 见 2.2.0); 8 是 压缩 变异 的 范围 ， 数 值 是 
[0,1] 之 间 的 一 个 数 ，delta 是 变异 步 长 的 大 小 。 
2.3 算法 步骤 

本 文 遗 传 算法 实现 使 用 现存 比较 流行 、 较 为 完善 MATLAB 
遗传 算法 工具 箱 08。 目 标 函 数 和 选择 遗传 操作 如 前 面 所 述 ， 则 
算法 的 流程 如 下 : 

(1) 在 最 大 变量 域 初始 化 种 群 P。 

(2) 种 群 P 分 别 运用 于 目标 点 云 ， 求 取 每 次 初始 变换 的 
空间 x、y、z 最 大 最 小 值 ， 求 取 整 个 空间 的 x、y、z 最 大 最 小 
值 ， 确 定 最 大 变换 空间 位 置 。 

(3) 计算 其 目标 函数 和 适应 值 。 

(4) 选取 种 群 中 最 优 个 体 得 到 其 空间 分 布 粹 SDE, 令 全 局 
最 小 空间 分 布 焙 SDEwin=SDE， 并 设 定 最 大 代数 G。 

(5) 根据 适应 度 值 进 行 优良 个 体 选择 , 对 选择 的 种 群 进行 
交叉 和 变异 操作 ， 产 生 新 一 代 进 化 种 群 。 

(6) 求解 新 一 代 种 群 所 有 个 体 的 适应 值 FinV， 比 较 该 代 
最 优 个 体 的 空间 分 布 炉 SDE 和 全 局 最 小 空间 分 布 焙 SDEwin, 如 
果 SDE<SDEmin 则 SDEmin =SDE。 

ge te sn te tole. 
若 没 有 达到 ， 则 转 到 步 又 (5)， 继 续 求 解 ， 否 则 ， 输 出 全 局 最 优 
ep te hn ba 


(8) 更 新 点 云 位 置 ， 输 出 配 准点 云 。 
2 所 示 。 


基 玩 准则 遗传 算法 流程 如 图 


图 2 基于 人 准 则 遗传 算法 流程 


3 ”实验 结果 与 分 析 


为 了 验证 算法 的 可 行 性 、 鲁 棒 性 和 有 效 性 ， 在 Intel Core- 
i5$，2 GB 内 存 的 Windows 7 操作 系统 上 ， 焙 准则 的 遗传 算法 基 
于 MATLAB 平台 进行 粗 配 准 实验 , 精 配 准 ICP 算法 基于 Visual 
C++ 平台 进行 精 配 准 实验 ， 主 要 从 有 缺陷 的 点 云 和 有 大 量 噪声 
点 两 方面 来 进行 验证 。 以 Stanford 的 bunny、cow、man 模型 为 
例 ， 两 个 不 同 视点 下 的 成 像 数据 P 和 2 为 例 ， 如 图 所 示 。 图 
3~6 分 别 给 出 了 粗 配 准 前 后 参考 点 云 和 目标 点 云 的 相对 位 置 ， 
其 中 (a) 两 片 点 云 位 置 相 错 90"，(b) 为 使 用 本 文 算法 粗 配 准 
后 的 结果 。 

a) 精简 后 的 bunny 模型 


凡 久 


(a) 相 错 900 
图 3 精简 bunny 点 云 粗 配 准 


(b) 粗 配 准 
前 后 相对 位 置 


b) 有 大 量 噪声 点 的 模型 


(a) 相 错 90" (b) 粗 配 准 
图 4 存在 噪点 点 云 粗 配 准 前 后 相对 位 置 
c) 有 点 云 缺失 的 点 云 模型 
(a) 相 错 90" bp) 初始 配 


图 5 精简 1/2 点 云 粗 配 准 前 后 相对 位 置 


(a) 相 错 90? (b) 粗 配 准 
图 6 精简 /4 点 云 粗 配 准 前 后 相对 位 置 
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为 观察 遗传 算法 各 代 的 数据 变化 规律 ， 
bunny 模型 的 求解 过 程 为 例 ， 如 图 
最 小 值 和 该 代 所 有 个 体 SDE 的 平均 值 的 变化 规律 。 


以 图 3 精简 后 的 
7 所 示 显 示 每 代 个 体 SDE 的 


由 


6.8 . 
一 解 的 变化 
sel 种 群 均值 的 变化 
[a 
A 6.4 
CD 
6.2 
60 20 40 60 
种 群 代数 
图 7 优化 解 的 目标 函数 值 及 性 能 跟踪 
人 


(a) 配 准 前 点 云 


(DJMSE 


(c) 文 献 [13] 


群 整体 向 着 最 优 的 方向 进行 ， 全 


ChinaXiv 合 作 | 
等 : 基于 炳 准则 遗传 算法 的 点 云 配 准 算 法 


办. 


陈 杰 ， 等: 粒 准 则 遗传 算法 的 点 准 算 


图 7 可 知 , 求解 过 程 中 各 代 的 SDE 平均 值 越 来 越 小 ,种 
局 最 优 解 在 迭代 过 程 中 根据 各 


代 局 部 最 优 解 的 情况 不 断 更 新 , 最 终 迭 代 到 全 局 最 优 及 SDE 最 
小 。 图 3~6 中 (b) 都 是 迭代 到 全 局 最 优 及 SDE 最 小 的 结果 。 从 
配 准 结果 可 以 表明 本 文 算法 能 处 理 重合 部 分 很 小 的 模型 ， 同 时 


能 抵抗 噪声 点 和 异常 值 点 的 干扰 。 
本 文 粗 配 准 算法 、 基 于 MSE 的 遗传 算法 、 参考 球 加 速 的 遗 


传 算法 、 快 速 的 PCA、4PCS 算法 进行 粗 配 


不 。 


立 置 ， 


效果 对 比如 图 8 所 


图 8 可 以 看 出 ， 本 文 算法 、MSE、 文 献 [13]、4PCS 对 完 
整 点 云 和 部 分 重合 的 点 云 都 能 提供 初始 
部 分 重合 的 点 云 粗 配 准 不 能 提供 初始 位 置 。 丁 


PCA 的 方法 针对 
已 准 结果 表明 ， 基 


于 米 ; 


i 


(dPCA 


图 8 点 云 的 粗 配 准 后 相对 位 置 关系 


表 3 不 同 模 型 粗 配 准时 间 /s 
模型 MSE ”文献 [13] PCA 4PCS 本文 
cow(2904) 72.98 50.50 0.32 40.35 36.83 
bunny(35947) 168.73 122.35 1.35 75.89 72.63 
man(7492) 100.62 70.20 0.56 38.26 42.36 


表 3 


展示 了 粗 配 准 的 时 间 ， 遗 传 算法 和 RANSAC 都 是 随 


机 性 算法 ， 算 法 运行 的 时 间 与 设置 的 参数 有 很 大 的 关系 。 


图 


同情 况 下 配 ; 


住所 


de 


9 点 云 点 数 与 时 间 的 变化 


9 所 示 是 本 文 算法 (SDE)、MSE、 文 献 [10] 在 点 云 点 数 不 
的 时 间 。 遗 传 算法 的 初始 种 群 和 遗传 代数 对 


E 则 的 遗传 算法 能 够 有 效 地 对 点 云 进 行 六 


(e)4PCS 


(1f) 本 文 算法 


有 配 准 。 


二 
3 
六 


算法 运行 时 间 有 很 大 的 联系 ， 三 种 算法 都 设置 初始 种 群 为 80， 
遗传 代数 为 40。 从 图 9 可 以 看 出 , 文献 [13] 和 MSE 配 准 的 时 间 
随 着 点 数 增多 上 升 迅速 ,而 SDE 方法 上 升 很 平缓 ,说 明基 于 业 


= 


求解 
搜索 时 间 急 剧 增加 。 


和 过/ 


在 利用 KDtree 寻找 最 近 点 


则 的 遗传 算法 可 以 进行 大 规模 的 点 云 配 准 。MSE 和 文献 [13] 
目标 函数 都 要 全 局 搜索 对 应 点 求解 距离 ， 随 着 点 数 增 大 ， 


用 基于 炉 准 则 的 遗传 算法 进行 粗 配 准 的 提供 的 初始 位 置 ， 


出 ， 本 文 的 在 运行 效率 上 1 


于 其 他 两 种 方法 ， 


配 准 精度 的 评 


判 , 采 


二 


Fail(pi ,ps) 定 义 如 下 : 
Fail(p,,p, ) 


其 中 : 


i=1 


N 


才 1 d (pi,p, ) 
0 0<al(p,,p, 


所 示 。 


的 改进 ICP 算法 进行 精 配 准 ， 并 与 
传统 ICPD 算 法 和 文献 [3] 进 行 比较 ， 如 表 4 


表 4 可 看 
都 能 达到 精度 要 


文献 [3] 使 用 的 标准 , 计算 公式 如 下 : 


YFail(p,,p, ) 


(8) 


>0O 


)ss (9) 


2 代表 不 能 满足 精度 要 求 对 应 点 数 的 比例 ，N 代表 对 应 
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点 对 数量 ; 4(Pi,P;) 代表 对 应 点 之 间 的 距离 ; 6 代表 距离 阀 值 ; 
Fail(pi ,ps ) 代 表 对 应 点 是 否 满足 精度 要 求 。 


地 


表 4 点 云 数 据 配 准 效果 比较 
算法 配 准 时 间 ” 配 准 精 度 
传统 ICP 42.78 0.00106324 


文献 3 80.56 0.00023852 
本 文 算法 40.67 0.00019683 


4 ”结束 语 


点 云 数据 配 准 是 逆向 工程 的 基础 ， 配 准 的 鲁 棒 性 、 效 率 和 
精度 对 点 云 配 准 非 常 重要 。 本 文 算法 对 于 有 异常 值 和 部 分 重合 
的 原始 点 云 的 处 理 有 较 好 的 效果 ， 但 是 在 效率 上 还 有 待 改进 。 

本 文 算法 具有 以 下 特点 : 

a) 通过 遗传 算法 避免 了 对 整个 变量 域 的 逐一 搜索 , 由 于 进 
化 的 导向 性 能 快速 的 获得 近似 最 优 解 ， 有 效 提高 了 最 小 点 云 空 
间 分 布 焙 的 求解 效率 ; 

b) 空间 分 布 炉 是 基于 空间 点 云 密 度 求解 , 当 点 云 有 异常 值 
时 对 空间 位 置 的 估计 影响 不 是 很 大 ; 

c) 遗传 算法 能 进行 并 行 计算 的 特点 , 在 此 基础 上 可 进一步 
提高 求解 效率 。 

ICP 算法 精度 高 的 特点 成 为 精 配 准 的 通用 方法 , 如 何 快 速 、 
精准 地 为 ICP 算法 提供 良好 的 初始 位 置 显得 很 具有 挑战 性 ， 在 
后 续 工 作 中 继续 改进 本 文 算 法 ， 以 进一步 提高 算法 的 效率 。 
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